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(57【 要約 】 
【 課題 】 ヒュ ー マ ノ イド ロボ ッ ト を 演技 させ る 際 に 、 


その 転倒 を 防止 する 。 
【 解決 手段 】 ワイ ヤ を 繰り 出し た り 引 き 込 むための ワ 


イヤ 伸縮 機構 1 乃至 3 を 備え 、 こ れ ら は それ ぞ れ 異な る 


位置 に 設け られ る 。 さ ら に 、 複 数 の 前 記 ワ イヤ 伸縮 機構 
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ゴ 画 柳 送 信 部 [ ほ ーー ゴ 撮像 部 


か ら の 複数 の ワイ ヤ に 接続 され た 交点 部 と 、 前 記 交 点 部 
に 設け られ て その 下方 を 撮影 する 撮像 部 5 1 と 、 一 端 が 
前 記 交点 部 に 接続 され 、 他 端 が 前 記 交点 部 の 下方 に 位置 
する 移動 体 に 接続 され た 移動 体 吊 り 上 げ 用 ワイ ヤ と 、 複 
数 の 前 記 ワ イヤ 伸縮 機構 を 制御 する 制御 部 1 00 と を 備 
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える 。 前 記 撮 像 部 で 撮影 し た 前 記 移動 体 の 画像 に 基づき 
前 記 移 動体 と 前記 撮像 部 の 相対 位置 関係 を 求め 、 求 め た 
相対 位置 関係 に 基づき 複数 の 前 記 ワ イヤ 伸縮 機構 を 駆動 
し て 、 前 記 交 点 部 を 前 記 移 動体 の 動き に 追従 させ る 。 

【 選択 図 】 図 3 
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【 特許 請求 の 範囲 】 
【 請求 項 1 】 

ワイ ヤ を 繰り 出し た り 引 き 込 むための ワイ ヤ 伸 縮 機構 を 少な が く と も 3 つ 備 え 、 複 数 の 前 
記 ワ イヤ 伸縮 機構 は それ ぞ れ 異な る 位置 に 設け ら れ 、 

さら に 、 複 数 の 前 記 ワ イヤ 伸縮 機構 か ら の 複数 の ワイ ヤ に 接続 され た 交点 部 と 、 前 記 交 
点 部 に 設け られ て その 人 下方 を 撮影 する 撮像 部 と 、 一 端 が 前 記 交 点 部 に 接続 され 、 他 端 が 前 
記 交 点 部 の 下方 に 位置 する 移動 体 に 接続 され た 移動 体 吊 り 上 げ 用 ワイ ヤ と 、 複数 の 前 記 ワ 
イヤ 伸縮 機構 を 制御 する 制御 部 と を 備え 、 

前 記 制御 部 は 、 前 記 撮 像 部 で 撮影 し た 前 記 移 動体 の 画像 に 基づき 前 記 移動 体 と 前 記 撮像 
部 の 相対 位置 関 作 を 求め 、 求 め た 相対 位置 関係 に 基づき 複数 の 前 記 ワ イヤ 伸縮 機構 の 全部 
又は 一 部 を 駆動 し て 、 前 記 交 点 部 が 前 記 移 動体 の 動き に 追従 する よう に 制御 する こと を 特 
徴 と する 移動 体 の 転倒 防止 装置 。 

【 請求 項 2 】 

複数 の 前 記 ワ イヤ 伸縮 機構 か ら の 複数 の ワイ ヤ の 前 記 交 点 部 へ の 接続 位置 関係 を 、 複 数 
の 前 記 ワ イヤ 伸縮 機構 の 位置 関係 の 相似 形 に し た こと を 特徴 と する 請求 項 1 記載 の 移動 体 
の 転倒 防止 装置 。 

【 請求 項 3 】 

前 記 制 御 部 は 、 

前 記 撮 像 部 で 取得 し た 前 記 移動 体 の 画像 に 基づき 、 前 記 移 動体 も し く は その 一 部 の 画像 
の 重心 位置 を 求め 、 こ れ と 予め 与え られ た 前 記 撮 像 部 か ら 前 記 移動 体 ま で の 距離 及び 前 記 
撮像 部 の 倍率 に 基づき 、 前 記 撮像 部 と 前 記 移 動体 間 の 相対 的 な 水平 位置 関係 (dx , dy 
) を 算出 し 、 

複数 の 前 記 ワ イヤ 伸縮 機構 か ら 前 記 交 点 部 まで の 各 ワ イヤ の 線 長 と 予め 定め られ た 各 ワ 
イヤ の 始点 座標 (X1, Y1, Z1) 、(X2,Y2,Z2) 、(X3、Y3,Z3) に 
基づき 、 前 記 撮 像 部 の 座標 (Xe, Ye, Ze ) を 算出 し 、 

算出 され た 座標 (Xe, Ye) に 相対 的 な 水平 位置 関係 (dx , dy ) を 加算 し て 目的 
位置 座標 (Xd, Yd,Zd) を 求め 、 

目的 位置 座標 (Xd , Yd , Zd) と 各 ワ イヤ の 始点 座標 (X1,Y1,.Z1) 、(X 
2,Y2,Z2) 、(X3、Y3,Z3) に 基づき 、 目 的 位置 座標 (Xd,Yd,Zd) 
で の 各 ワ イヤ の 線 長 を 算出 し 、 

複数 の 前 記 ワ イヤ 伸縮 機構 か ら 前 記 交 点 部 まで の 各 ワ イヤ の 線 長 が 、 そ れ ぞ れ 算 出さ れ 
た 線 長 に な る よう に 複数 の 前 記 ワ イヤ 伸縮 機構 を 制御 する こと を 特徴 と する 請求 項 1 記載 
の 移動 体 の 転倒 防止 装置 。 

【 請求 項 4 】 

前 記 制御 部 は 、 前 記 撮 像 部 で 取得 し た 前 記 移 動体 の 画像 の 大 き さ と 予め 定め られ た 前 記 
撮像 部 の 倍率 に 基づき 、 前 記 撮像 部 か ら 前 記 移 動体 まで の 距離 d z を 算出 し 、 こ の 距離 g 
z と 前 記 撮 像 部 の Z 座標 Ze に 基づき 、 前 記 移動 体 と 前 記 撮像 部 の 間 の 距離 を 一 定 に する 
よう に 、 複 数 の 前 記 ワ イヤ 伸縮 機構 を 制御 する こと を 特徴 と する 請求 項 3 記載 の 移動 体 の 
転倒 防止 装置 。 

【 請求 項 5】 

前 記 制御 部 は 、 前 記 撮 像 部 の 座標 (Xe, Ye,Ze) 、 目 的 位置 座標 (Xdq,Yd, 
Zd) 、 相 対 的 な 水平 位置 関 作 (dx , dy ) 及び 前 記 撮像 部 か ら 前 記 移 動体 まで の 距離 
d z の 全部 又は 一 部 が それ ぞ れ 予め 定め られ た 範囲 を 超え た と き 、 前 記 移 動体 に 停止 命令 
又は 減速 命令 を 送る こと を 特徴 と する 請求 項 3 記載 の 移動 体 の 転倒 防止 装置 。 

【 請求 項 6 】 

前 記 制御 部 は 、 前 記 撮 像 部 で 取得 し た 前 記 移 動体 の 画像 画像 に 基づき 、 前 記 移動 体 が 転 
倒し た と 判断 し た と き 、 又 は 、 外 部 か ら 前 記 移 動体 の 転倒 を 示す 信号 を 受け た と き の 何 れ 
か の 場合 に 、 前 記 交 点 部 の 追従 を 停止 させ る か 、 又は 、 前 記 交 点 部 を 上 昇 さ せる よう に 、 
複数 の 前 記 ワ イヤ 伸縮 機構 を 制御 する こと を 特徴 と する 請求 項 3 記載 の 移動 体 の 転倒 防止 
装置 。 
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【 請求 項 7 】 

ワイ ヤ を 繰り 出し た り 引 き 込 むための ワイ ヤ 伸 縮 機構 を 少な かく と も 3 つ 備 え 、 複 数 の 前 
記 ワ イヤ 伸縮 機構 は それ ぞ れ 異な る 位置 に 設け ら れ 、 

さら に 、 複 数 の 前 記 ワ イヤ 伸縮 機構 か ら の 複数 の ワイ ヤ に 接続 され た 交点 部 と 、 前 記 交 
点 部 に 設け られ て その 下方 を 撮影 する 撮像 部 と 、 一 端 が 前 記 交 点 部 に 接続 され 、 他 端 が 前 
記 交 点 部 の 下方 に 位置 する 移動 体 に 接続 され た 移動 体 吊 り 上 げ 用 ワイ ヤ と 、 を 備え る 装置 
に より 前 記 移 動体 を 支え る 方 法 で あっ て 、 

前 記 撮 像 部 で 取得 し た 前 記 移動 体 の 画像 に 基づき 、 前 記 移 動体 も し く は その 一 部 の 画像 
の 重心 位置 を 求め 、 こ れ と 予め 与え られ た 前 記 撮 像 部 か ら 前 記 移動 体 ま で の 距離 及び 前 記 
撮像 部 の 倍率 に 基づき 、 前 記 撮 像 部 と 前 記 移 動体 間 の 相対 的 な 水平 位置 関係 (dx , dy 
) を 算出 する ステ ッ プ と 、 

複数 の 前 記 ワ イヤ 伸縮 機構 か ら 前 記 交 点 部 まで の 各 ワ イヤ の 線 長 と 予め 定め られ た 各 ワ 
イヤ の 始点 座標 (X1, マル 。 Z1) 、(X2,Y2,Z2) 、(X3、Y3,Z3) に 
基づき 、 前 記 撮 像 部 の 座標 (Xe, Ye, Ze ) を 算出 する ステ ッ プ と 、 

算出 され た 座標 (Xe, Ye ) に 相対 的 な 水平 位置 関係 (dx, dy ) を 加算 し て 目的 
位置 座標 (Xd, Yd , Zd ) を 求め る ステ ッ プ と 、 

目的 位置 座標 (Xd, Yd , Zd ) と 各 ワ イヤ の 始点 座標 (X1,.Y1,.Z1) 、(X 
2,Y2,Z2) 、(X3、Y3,Z3 ) に 基づき 、 目 的 位置 座標 (Xdq,Yd,Zd) 
で の 各 ワ イヤ の 線 長 を 算出 する ステ ッ プ と 、 

複数 の 前 記 ワ イヤ 伸縮 機構 か ら 前 記 交 点 部 まで の 各 ワ イヤ の 線 長 が 、 そ れ ぞ れ 算 出さ れ 
た 線 長 に な る よう に 複数 の 前 記 ワ イヤ 伸縮 機構 を 制御 する ステ ッ プ と 、 を 備え る 移動 体 を 
支え る 方 法 。 

【 請求 項 8 】 

ワイ ヤ を 繰り 出し た り 引 き 込 むための ワイ ヤ 伸 縮 機構 を 少な か なく と も 3 つ 備 え 、 複 数 の 前 
記 ワ イヤ 伸縮 機構 は それ ぞ れ 異な る 位置 に 設け ら れ 、 

さら に 、 複 数 の 前 記 ワ イヤ 伸縮 機構 か ら の 複数 の ワイ ヤ に 接続 され た 交点 部 と 、 前 記 交 
点 部 に 設け られ て その 下方 を 撮影 する 撮像 部 と 、 一 端 が 前 記 交 点 部 に 接続 され 、 他 端 が 前 
記 交 点 部 の 下方 に 位置 する 移動 体 に 接続 され た 移動 体 吊 り 上 げ 用 ワイ ヤ と 、 を 備え る 装置 
に より 前 記 移 動体 を 支え る 方 法 を コン ピュ ー タ に 実行 させ る た め の プ ログ ラム で あっ て 、 

前 記 撮 像 部 で 取得 し た 前 記 移動 体 の 画像 に 基づき 、 前 記 移 動体 も し く は その 一 部 の 画像 
の 重心 位置 を 求め 、 こ れ と 予め 与え られ た 前 記 撮 像 部 か ら 前 記 移動 体 ま で の 距離 及び 前 記 
撮像 部 の 倍率 に 基づき 、 前 記 撮像 部 と 前 記 移 動体 間 の 相対 的 な 水平 位置 関係 (dx , dy 
) を 算出 する ステ ッ プ と 、 

複数 の 前 記 ワ イヤ 伸縮 機構 か ら 前 記 交 点 部 まで の 各 ワ イヤ の 線 長 と 予め 定め られ た 各 ワ 
イヤ の 始点 座標 (X1, Y1, Z1) 、(X2,Y2,Z2)、(X3、Y3,Z3) に 
基づき 、 前 記 撮 像 部 の 座標 (Xe, Ye, Ze ) を 算出 する ステ ッ プ と 、 

算出 され た 座標 (Xe, Ye) に 相対 的 な 水平 位置 関係 (dx , dy ) を 加算 し て 目的 
位置 座標 (Xd, Yd , Zd ) を 求め る ステ ッ プ と 、 

目的 位置 座標 (Xd, Yd,Zd) と 各 ワ イヤ の 始点 座標 (X1,.Y1,.Z1) 、(X 
2, Y2,Z2) 、(X3、Y3,Z3) に 基づき 、 目 的 位置 座標 (Xd,Yd,Zd) 
で の 各 ワ イヤ の 線 長 を 算出 する ステ ッ プ と 、 

複数 の 前 記 ワ イヤ 伸縮 機構 か ら 前 記 交 点 部 まで の 各 ワ イヤ の 線 長 が 、 そ れ ぞ れ 算 出さ れ 
た 線 長 に な る よう に 複数 の 前 記 ワ イヤ 伸縮 機構 を 制御 する ステ ッ プ と 、 を 実行 させ る た め 
の プロ グラ ム 。 

【 発明 の 詳細 な 説明 】 
【 技術 分 野 】 
92020 1 】 

本 発明 は 、 ヒ ュー マ ノ イ ドロ ボッ ト 、2 足 歩行 ロボ ッ ト を 含む 移動 体 の 転倒 防止 の た め 
の 装置 及び 移動 体 を 支え る 方 法 並び に 当該 方 法 を コン ピュ ー タ に 実行 させ る た め の プ ログ 
ラム に 関す る 。 
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【 背景 技術 】 

【0002】 

【 特許 文献 1 】 特 開 2004-90126 号 公報 

【 特許 文献 2 】 特 開 2004-267544 公 報 

【0003】 

特許 文献 1 は 、 移 動 ロ ボッ ト の 上 部 を 、 該 移動 ロボ ッ ト の 上 方 に 設置 され た 走行 レー ル 
に 沿っ て 走行 する ホイ スト に 繰り 出し 巻き 取り 自在 に 巻 回 され た ワイ ヤ の 下端 部 に 連結 し 
、 前記 移 動 ロ ボッ ト と ホイ スト と が 前 記 ワ イヤ を 介し て 連携 移動 せしめ る よう に し た 移動 
ロボ ッ ト の 転倒 防止 方 法 に お いて 、 前 記 移 動 ロ ボッ ト を 2 軸 方 向 に 移動 せしめ 、 前 記 ホ イ 
スト を 、 前 記 移 動 ロ ボッ ト の 移動 検知 信号 ある い は 移動 設定 信号 に より 該 移動 ロボ ッ ト の 
移動 に 追従 させ て 前 記 2 軸 方 向 に 走行 させ る こと を 特徴 と する ホイ スト に ワイ ヤ を 介し て 
連携 移動 され る 移動 ロボ ッ ト を 該 移動 ロ ボッ ト に 無用 な 外力 を 加え る こと な く 正 確 に 連携 
移動 せしめ 得る と と も に 、 該 移動 ロボ ッ ト の 転倒 予知 を 正確 に 成 し 得 る よう に し て 、 和 移動 
ロボ ッ ト の 転倒 の 発生 を 防止 で きる 移動 ロボ ッ ト の 転倒 防止 方 法 及 びそ の 装置 を 開示 する 


[0004]】 

特許 文献 2 は 、 移 動 式 一 点 吊 装置 に お いて 、 移 動 部 の リー ル 中 心から フッ ク 先 端 ま で の 
長 さ を 変化 させ る こと な く フ ッ ク の 吊り 下げ 位置 を 移動 で せき る よう に する 装置 を 開示 する 
【0005】 

し か し な が ら 、 上 記 従 来 の 技術 は 、 い ずれ も 巻き 上 げ リ ー ル が 水平 方 向 に 移動 し 、 高 さ 
方 向 は リー ル で フッ ク を 巻き 上 げ る 構造 の も の で ある 。 これら の 構造 は 古典 的 な X 軸 と Y 
軸 の 水平 移動 と Z 還 で の 巻き 上 げ 垂 直 移 動 制御 で ある 。 

【 発明 の 開示 】 
【 発明 が 解決 し よう と する 課題 】 
【0006】 

2 足 歩 行 自律 動作 ( 歩行 、 屈 伸 、 お 辞 儀 、 階 段 昇 降 等 ) を 行う ヒュ ー マ ノ イド ロボ ッ ト 
を 演技 させ る に お いて 、 現状 で は その 稼動 条件 が 厳し く 、 し か も その 動作 が 不安 定 で 、 床 
に 塵 が ある だ け で も 転倒 する こと が ある 。 転倒 を 防止 する た め 、 ロ ボッ ト の 移動 に クレ ー 
ン を 追従 させ て ロボ ッ ト の 転倒 を 防止 する 必要 が ある 。 

9009 プッ 

特許 文献 1 や 2 に 記載 され た 従来 の 技術 は 、 古 典 的 な X 軸 と Y 軸 の 水平 移動 と Z 軸 で の 
巻き 上 げ 垂 直 移 動 制 御方 式 の クレ ー ン で ある 。 ヒ ュー マ ノ イ ドロ ボッ ト の よう な 先端 技術 
の ロボ ッ ト を 演技 させ る 場合 、 顧 客 に よっ て は この よう な 古典 的 な 制御 方 法 で な され た 装 
置 は 先端 技術 の ロボ ッ ト に は 不 釣合い で 好ま な いた め 、 先 進 的 で 斬新 な か ロボット の 転倒 防 
止 装置 制御 シス テム が 求め られ る 。 

【0008】 

また 、 古 典 的 な X 軸 と Y 軸 の 水平 移動 と Z 軸 で の 巻き 上 げ 垂 直 移 動 制 御 シ レス テム は いわ 
ゆる 天井 クレ ー ン の よう に 天井 に 大 掛か りな 駆動 レー ル 等 が 必要 で あり 、 台 の 演出 上 ま 
た は 建造 物 の 構造 的 に その よう な 天井 クレ ー ン 様 の 装置 が 設置 不可 能 な 場合 が ある 。 
【0009】 

本 発明 は 、 こ の よう な 要望 に 応え る こと の で きる 制御 シレ シス テム で ある 。 
課題 を 解決 する た め の 手 段 】 
【0010]】 

本 発明 は 上 記 課 題 を 解決 する た め に な され た も の で 、 本 発明 は 、 舞 台 上 の 空間 の 任意 の 
位置 座標 X ベ YZ が 3 固定 点 か ら の 距離 が 分 か れ ば 算出 で きる こと を 利用 し 少な く と も 3 本 
の ワイ ヤ を 制御 する も の で あり 、 天 井 に 大 掛か りな 駆動 レー ル 等 を 必要 と せ ず 、 し か も 従 
来 に 無い 先進 的 で 斬新 な も の で ある 。 具体 的 に は 、 天 井 の 3 点 を 基準 点 と し て 3 本 の ワイ 
ヤ の 長 さ を 制御 し 、 ワ イヤ の 交点 を XYZ 選 の 3 次元 で 同時 に 空間 移動 制御 させ る シス テム 
で あり 、 ワ イヤ の 交点 部 分 に 取り 付け た 撮像 部 で 取得 し た 画像 を 処理 する こと に より ヒュ 


と で 
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ー マ ノ イド ロボ ッ ト 等 の 追従 対象 物 ( 移動 体 ) を 認識 し 、 撮 像 部 か ら の XYZ の 偏差 求め 
、 対 象 物 へ の 追従 制御 を 行う 。 
【[0011]】 

この 発明 に 係る 移動 体 の 転倒 防止 装置 は 、 ワ イヤ を 繰り 出し た り 引 き 込 むための ワイ ヤ 
伸縮 機構 を 少な な く な と も 3 つ 備 え 、 複 数 の 前 記 ワ イヤ 伸縮 機構 は それ ぞ れ 異な る 位置 に 設け 
られ 、 

さら に 、 複 数 の 前 記 ワ イヤ 伸縮 機構 か ら の 複数 の ワイ ヤ に 接続 され た 交点 部 と 、 前 記 交 
点 部 に 設け られ て その 下方 を 撮影 する 撮像 部 と 、 一 端 が 前 記 交 点 部 に 接続 され 、 他 端 が 前 
記 交 点 部 の 下方 に 位置 する 移動 体 に 接続 され た 移動 体 吊 り 上 げ 用 ワイ ヤ と 、 複数 の 前 記 ワ 
イヤ 伸縮 機構 を 制御 する 制御 部 と を 備え 、 

前 記 制御 部 は 、 前 記 撮 像 部 で 撮影 し た 前 記 移 動体 の 画像 に 基づき 前 記 移動 体 と 前 記 撮像 
部 の 相対 位置 関 作 を 求め 、 求 め た 相対 位置 関係 に 基づき 複数 の 前 記 ワ イヤ 伸縮 機構 の 全部 
又は 一 部 を 駆動 し て 、 前 記 交 点 部 が 前 記 移 動体 の 動き に 追従 する よう に 制御 する も の で あ 
る 。 

[0012]】 

好ま し く は 、 複 数 の 前 記 ワ イヤ 伸縮 機構 か ら の 複数 の ワイ ヤ の 前 記 交 点 部 へ の 接続 位置 
関係 を 、 複 数 の 前 記 ワ イヤ 伸縮 機構 の 位置 関係 の 相似 形 に する 。 
[0013]】 

前 記 制 御 部 は 、 

前 記 撮 像 部 で 取得 し た 前 記 移 動体 の 画像 に 基づき 、 前 記 移 動体 も し く は その 一 部 の 画像 
の 重心 位置 を 求め 、 こ れ と 予め 与え られ た 前 記 撮 像 部 か ら 前 記 移動 体 ま で の 距離 及び 前 記 
撮像 部 の 倍率 に 基づき 、 前 記 撮像 部 と 前 記 移 動体 間 の 相対 的 な 水平 位置 関係 (dx , dy 
) を 算出 し 、 

複数 の 前 記 ワ イヤ 伸縮 機構 か ら 前 記 交 点 部 まで の 各 ワ イヤ の 線 長 と 予め 定め られ た 各 ワ 
イヤ の 始点 座標 (X1, Y1, Z1) 、(X2,Y2,Z2) 、(X3、Y3,Z3) に 
基づき 、 前 記 撮 像 部 の 座標 (Xe, Ye, Ze ) を 算出 し 、 

算出 され た 座標 (Xe, Ye) に 相対 的 な 水平 位置 関係 (dx , dy ) を 加算 し て 目的 
位置 座標 (Xd, Yd,Zd) を 求め 、 

目的 位置 座標 (Xd , Yd,Zd) と 各 ワ イヤ の 始点 座標 (X1,Y1,.Z1) 、(X 
2,Y2,Z2) 、(X3、Y3,Z3) に 基づき 、 目 的 位置 座標 (Xd,Yd,Zd) 
で の 各 ワ イヤ の 線 長 を 算出 し 、 

複数 の 前 記 ワ イヤ 伸縮 機構 か ら 前 記 交 点 部 まで の 各 ワ イヤ の 線 長 が 、 そ れ ぞ れ 算 出さ れ 
た 線 長 に な る よう に 複数 の 前 記 ワ イヤ 伸縮 機構 を 制御 する も の で ある 。 

【[0014]】 

前 記 制 御 部 は 、 前 記 撮 像 部 で 取得 し た 前 記 移 動体 の 画像 の 大 き さ と 予め 定め られ た 前 記 
撮像 部 の 倍率 に 基づき 、 前 記 撮像 部 か ら 前 記 移 動体 まで の 距離 d z を 算出 し 、 こ の 距離 g 
z と 前 記 撮 像 部 の Z 座標 Ze に 基づき 、 前 記 移 動体 と 前 記 撮像 部 の 間 の 距離 を 一 定 に する 
よう に 、 複 数 の 前 記 ワ イヤ 伸縮 機構 を 制御 し て も よい 。 

[0015]】 

前 記 制 御 部 は 、 前 記 撮 像 部 の 座標 (Xe, Ye,Ze) 、 目 的 位置 座標 (Xdq,Yd, 
Zd) 、 相 対 的 な 水平 位置 関係 (dx, dy ) 及び 前 記 撮 像 部 か ら 前 記 移 動体 まで の 距離 
dz の 全部 又は 一 部 が それ ぞ れ 予め 定め られ た 範囲 を 超え た と き 、 前 記 移 動体 に 停止 命令 
又は 減速 命令 を 送る よう に し て も よい 。 

【0016】 

前 記 制 御 部 は 、 前 記 撮 像 部 で 取得 し た 前 記 移 動体 の 画像 画像 に 基づき 、 前 記 移動 体 が 転 
倒し た と 判断 し た と き 、 又 は 、 外 部 か ら 前 記 移 動体 の 転倒 を 示す 信号 を 受け た と き の 何 れ 
か の 場合 に 、 前 記 交 点 部 の 追従 を 停止 させ る か 、 又は 、 前 記 交 点 部 を 上 昇 さ せる よう に 、 
複数 の 前 記 ワ イヤ 伸縮 機構 を 制御 する よう に し て も よい 。 

【[0017]】 
この 発明 は 、 ワ イヤ を 繰り 出し た り 引 き 込 むための ワイ ヤ 伸 縮 機構 を 少な く と も 3 つ 備 
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え 、 複 数 の 前 記 ワ イヤ 伸縮 機構 は それ ぞ れ 異な る 位置 に 設け られ 、 

さら に 、 複 数 の 前 記 ワ イヤ 伸縮 機構 か ら の 複数 の ワイ ヤ に 接続 され た 交点 部 と 、 前 記 交 
点 部 に 設け られ て その 人 下方 を 撮影 する 撮像 部 と 、 一 端 が 前 記 交 点 部 に 接続 され 、 他 端 が 前 
記 交 点 部 の 下方 に 位置 する 移動 体 に 接続 され た 移動 体 吊 り 上 げ 用 ワイ ヤ と 、 を 備え る 装置 
に より 前 記 移 動体 を 支え る 方 法 で あっ て 、 

前 記 撮 像 部 で 取得 し た 前 記 移動 体 の 画像 に 基づき 、 前 記 移 動体 も し く は その 一 部 の 画像 
の 重心 位置 を 求め 、 こ れ と 予め 与え られ た 前 記 撮 像 部 か ら 前 記 移動 体 ま で の 距離 及び 前 記 
撮像 部 の 倍率 に 基づき 、 前 記 撮像 部 と 前 記 移 動体 間 の 相対 的 な 水平 位置 関係 (dx , dy 
) を 算出 する ステ ッ プ と 、 

複数 の 前 記 ワ イヤ 伸縮 機構 か ら 前 記 交 点 部 まで の 各 ワ イヤ の 線 長 と 予め 定め られ た 各 ワ 
イヤ の 始点 座標 (X1, Y1, Z1) 、(X2,Y2,Z2) 、(X3、Y3,Z3) に 
基づき 、 前 記 撮 像 部 の 座標 (Xe, Ye, Ze ) を 算出 する ステ ッ プ と 、 

算出 され た 座標 (Xe, Ye ) に 相対 的 な 水平 位置 関係 (dx , dy ) を 加算 し て 目的 
位置 座標 (Xd, Yd , Zd ) を 求め る ステ ッ プ と 、 

目的 位置 座標 (Xd , Yd , Zd) と 各 ワ イヤ の 始点 座標 (X1,.Y1,.Z1) 、(X 
2,Y2,Z2) 、(X3、Y3,Z3) に 基づき 、 目 的 位置 座標 (Xd,Yd,Zd) 
で の 各 ワ イヤ の 線 長 を 算出 する ステ ッ プ と 、 

複数 の 前 記 ワ イヤ 伸縮 機構 か ら 前 記 交 点 部 まで の 各 ワ イヤ の 線 長 が 、 そ れ ぞ れ 算 出さ れ 
た 線 長 に な る よう に 複数 の 前 記 ワ イヤ 伸縮 機構 を 制御 する ステ ッ プ と 、 を 備え る も の で あ 
る 。 
[0018]】 

この 発明 は 、 上 記 方 法 を コン ピュ ー タ に 実行 させ る た め の プ ログ ラム で ある 。 

この 発明 に 係る プロ グラ ム は 、 例 えば 、 記 録 媒体 に 記録 され る 。 

媒体 に は 、 例 えば 、EPROM デ バイ ス 、 フ ラッ シュ メモ リ デ バ イス 、 フ レキ シブ ル デ 
ィ ス ク 、 ハ ー ド ディ スク 、 磁気 テ ー プ 、 光 磁気 ディ スク 、CD(CD-ROM、Vi de 
o-CD を 含む ) 、DVD(DVD-Video、DVD-ROM、DVD-RAM を 含 
お む お ) 、ROM カ ー ト リッ ジ 、 バ ッ テ リ バッ クア ッ プ 付き の RAM メ モリ カー トリ ッ ジ 、 フ 
ラッ シュ メモ リカ ー ト リッ ジ 、 不 揮発 性 RAM カート リッ ジ 等 を 含む 。 

【0019】 

媒体 と は 、 何 等 か の 物理 的 手段 に より 情報 ( 主 に デジ タル デー タ 、 プ ログ ラム ) が 記録 
され て いる も の で あっ て 、 コ ンピュータ 、 専 用 プロ セッ サ 等 の 処理 装置 に 所 定 の 機能 を 行 
わせ る こと が で きる も の で ある 。 

【0020】 

現在 実現 され て いる 大 型 二 足 歩行 ロボ ッ ト ( 移動 体 ) は 基本 的 に 二 足 歩行 が 可能 な 製品 
で ある が 、 何 ら か の トラ ブル に よっ て 転倒 する 可能 性 は 皆無 で は 無い 。 万 一 転倒 し た 場合 
、 装 置 そ の も の が 受け る ダメ ー ジ が 問題 と な る 。 そ こ で 、 ロ ボッ ト が 転倒 し か か っ た 時 に 
、 そ の 状態 を 認識 し て 防止 する 仕組 み を 備え る こと が 好ま し い 。 実際 に は 、 転 倒し か か っ 
た 時 に ロボ ッ ト 本体 に 取り 付け た ワイ ヤ を 上 方 か ら 吊 下げ る 方 式 が 最も 望ま し いと 考え ら 
れる 。 ワ イヤ の 天井 側 吊り 元 を 固定 位置 と し て 検討 する と 、 ロ ボッ ト に と っ て は ワイ ヤ を 
引っ 張っ て 歩く 事 は 外力 を 受け る 事 と な り 、 歩行 た め の バ ラン ス 制 御 に 支障 を 来たす こと 
が ある 。 ま た 、 吊 り 元 (装置 ) が 水平 方 向 に 可動 式 だ と し て も ロボ ッ ト の 歩行 移動 に 連れ 
て 引っ 張ら れる パッ シブ な 方 式 で は 吊り 元 固定 と 同様 に 支障 を 来たす 事 が 分 か っ た 。 そ の 
点 、 本 発明 に よれ ば 上 記 の よう な 問題 は 生じ な い 。 

【 発明 を 実施 する た め の 最 良 の 形態 】 
【0021】 

以下 、 本 発明 の 実施 の 形態 に 係わる 移動 体 の 転倒 を 防止 する 制御 シス テム に つい て 説明 
する 。 本 発明 の 実施 の 形態 は 、 天 井 の 3 点 を 基準 点 と し 、3 本 の ワイ ヤ の 長 さ を 制御 し 、 
ワイ ヤ の 交点 を XYZ の 3 次 元 で 制御 し 、 適 宜 空間 移動 させ る シス テム で ある 。 
[0022]】 

図 1 は 本 シス テム の 全体 構成 及び その 使用 状況 を 示す 説明 図 で ある 。 本 シス テム は 、 例 
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えば 博物 館 等 に 設置 され ロボ ッ ト の 操作 を 疑似 体験 で きる も の で ある 。 博物 館 等 の 広い ホ 
ー ル に 設け られ た ステ ー ジ S 上 を ロボ ッ ト (移動 体 ) 7 が 自在 に 歩き 、 要 求 に 応じ て 人 形 
を 抱き か か えた り 、 和 物品 を 取り 上 げ 指 定 の 場所 に 置い た りす る 。 こ れ ら の 動作 は 一 種 の デ 
モン スト レー ショ ン で ある 。 そ の た め 、 ロ ボッ ト 7 の 移動 範囲 は 円 形 の ステ ー ジ S の 中 だ 
け に 限定 され て いる 。 こ れ に 伴い 本 シス テム の 作用 範囲 も 限定 され る が 、 上 記 用 途 で は 問 
題 と は な ら な い 。 

【0023】 

ステ ー ジ S の 全 範 囲 を ロボ ッ ト 7 が 移動 で きる よう に 、 ス テー ジ S の 外側 に 3 つの ワイ 
ヤ 伸 縮 機構 1 乃至 3 が 設け られ て いる 。 ワ イヤ 伸縮 機構 1 乃至 3 は 、 こ れ ら と ステ ー ジ S 
の 中 心 を 結ぶ 線 で あっ て 隣接 する 線 の 角度 が 概ね 1 20 度 (等 間隔 ) に な る よう に 設置 さ 
れ て いる 。 本 発明 は その よう な 角度 に 限定 され な い が 、 安定 し た 制御 を 行う た め に 1 2 0 
度 が 好ま し い 。 ワ イヤ 伸縮 機構 1 乃至 3 の 高 さ は ロボ ッ ト 7 より も 十分 高い 位置 (し か も 
観客 に 触れ な い 程 度 の 十分 な 高 さ 、 例 えば 3 乃至 4 m ) で ある 。 

【0024】 

ワイ ヤ 伸 縮 機 構 1 乃至 3 は 、 そ れ ぞ れ ワ イヤ 121, 221,321 を 伸ばし た り 引 っ 
込め た りす る こと が で きる (例え ば 、 ワ イヤ を 巻き 取る リー ル を 含む ) 。 ワ イヤ 121, 
221 , 32 1 の 端 は 円 盤 4 に 結び 付け られ て いる 。 円盤 4 を ワイ ヤ の 交点 部 と 呼ぶ こ 
が ある 。 ワ イヤ 伸縮 機構 1 乃至 3 で ワイ ヤ 121, 221,321 を 適宜 伸ばし た り 引 っ 
込め た りす る こと で 円 盤 4 の 位置 及び 高 さ を 調整 する こと が で きる 。 例え ば 、 ワ イヤ 1 2 
1 , 221 , 32 1 を 巻き 取る こと で 適当 な 張力 を 与え れ ば 円 盤 4 の 位置 は 高く な り ( 最 
高 で ワイ ヤ 伸 縮 機 構 1 乃至 3 の 取り 付け 位置 ) 、 逆 に ワイ ヤ 121 ,. 221, 321 を 繰 
り 出 し て 緩め る と 円 盤 4 の 位置 は 低く な る ( ステー ジ S に 触れ る まで 下げ る こと が で きる 
) 。 ま た 、 ワ イヤ 1 21 , 221,32 1 の 一 部 を 巻き 取り 、 残 り を 繰り 出す よう に すれ 
ば 、 円 盤 4 は 巻き 取っ た 方 の ワイ ヤ 伸 縮 機 構 に 向かっ て 移動 する 。 

[0025]】] 

円 盤 4 に は ロボ ッ ト 吊り 上 げ 用 ワイ ヤ 6 1 , 6 2 が 取り 付け られ て いる 。 その他 端 は ロ 
ボッ ト 7 に 接続 され て いて 、 ロ ボッ ト 7 が 転倒 し そう に な っ た と き に それ を 支え る よう に 
機能 する 。 前 述 の よう に 、 円 盤 4 の 位置 は 制御 可能 で ある の で 、 ロ ボッ ト 7 が ステ ー ジ S 
内 を 移動 する 限り 追従 可能 で ある 。 し か も 、 円 盤 の 高 さ も 制御 可能 で ある の で 、 ロ ボッ ト 
7 が か が ん だ り 、 座 っ た り 、 立 っ た り と いっ た 動き に も 追従 可能 で ある 。 

【0026】 

図 1 の 例 で は 、 ス テー ジ S の 一 部 に 設け られ た コッ ク ピ ッ ト C で ロボ ッ ト 7 の 動き を 操 
作 す る こと が で きる 。 当該 動 き に 併せ て 本 シス テム の 円 盤 4 は 自動 的 に ロボ ッ ト 7 に 追従 
する 。 その 具体 的 な 処理 は 後述 する 。 

【0027】 

図 2 に 円 盤 4 の 斜視 図 を 示す 。3 本 の ワイ ヤ 1 21 , 221, 321 及び ロボ ッ ト 吊り 
上 げ 用 ワイ ヤ 6 1 , 62 が 結合 され て いる の は 前 述 し た 。 円 盤 4 の 略 中 心 に 下 に 向け て デ 
ジタル カメ ラ な どの 撮像 部 51 が 設け られ て いる 。 撮像 部 5 1 は 撮影 可能 範囲 A 内 の 画像 
を 取得 する も の で ある が 、 特 に ロボ ッ ト 7 の 画像 を 取得 する た め の も の で ある 。 円 盤 4 に 
は ロボ ッ ト 吊り 上 げ 用 ワイ ヤ 6 1 , 62 が 結合 され て いる の で 円 盤 4 の 下 に は ロボ ッ ト 7 
が 常に 位置 し て いる 。 も っ と も 、 円 盤 4 の 位置 が 低い と き は ロボ ッ ト 吊り 上 げ 用 ワイ ヤ 6 
1 , 62 が た る み 、 ロ ボッ ト 7 は 円 盤 4 か ら 多 少 離れ る こと が で きる よう に な る 。 
【0028】 

図 3 に 本 発明 の 実施 の 形態 に 係る シス テム の ブロ ッ ク 図 を 示す 。5 1 は 前 述 の 撮像 部 、 
5 1 a は 撮像 部 51 の 取得 し た 画像 を 無線 な ど で 送 信 す る 画像 送信 部 、5 2 は 画像 受信 部 
、5 3 は 受信 し た 画像 を 処理 する 画像 処理 部 ( 具体 的 な 処理 内 容 は 後述 する ) 、1 00 は 
CPU、1001 は CPU の 制御 の 基づき サー ボ モ ー タ の 指令 信号 ( 指令 パル ス ) を 出力 
する 指令 パル ス 演 算 部 で ある 。 

【0029】 
本 シス テム は 、3 つの ワイ ヤ 伸 縮 機 構 1 , 2 , 3 を 備え 、 そ れ ぞ れ を 独立 し て 制御 し て 


30 


(89 JP 2006-224202 A 2006.8.31 


いる 。 

【0030】 

ワイ ヤ 伸 縮 機 構 1 の た め に 、 第 1 サー ボ モ ー タ 制御 部 1 01 1 、 第 1 サー ボ モ ー タ 1 1 
、 第 1 ワイ ヤ 伸 張 部 1 2 、 第 1 線 長 検出 器 13 が 設け られ て いる 。 第 1 サー ボ モ ー タ 1 1 
、 第 1 ワイ ヤ 伸 張 部 1 2 及び 第 1 線 長 検出 器 1 3 は 、 ワ イヤ 伸縮 機構 1 を 構成 する 。 
【0031】 

ワイ ヤ 伸 縮 機構 2? の た め に 、 第 2 サー ボ モ ー タ 制御 部 1 01 2 、 第 2 サー ボ モ ー タ 2 1 
、 第 2 ワイ ヤ 伸 張 部 2 2 、 第 2 線 長 検出 器 23 が 設け られ て いる 。 第 2 サー ボ モ ー タ 2 1 
、 第 2 ワイヤ 伸 張 部 2 2 及び 第 2 線 長 検出 器 23 は 、 ワ イヤ 伸縮 機構 2 を 構成 する 。 
【0032】 

ワイ ヤ 伸 縮 機 構 3 の た め に 、 第 3 サー ボ モ ー タ 制御 部 1 013 、 第 3 サー ボ モ ー タ 3 1 
、 第 2 ワイ ヤ 伸 張 部 3 2 、 第 3 線 長 検出 器 3 3 が 設け られ て いる 。 第 3 サー ボ モ ー タ 3 1 
、 第 2 ワイ ヤ 伸 張 部 3 2 及び 第 3 線 長 検出 器 33 は 、 ワ イヤ 伸縮 機構 3 を 構成 する 。 
【0033】 

上 記 サ ー ボ モー タ 制 御 部 、 サ ー ボ モー タタ 及び ワイ ヤ 伸 張 部 は いずれ も 公知 の も の で あり 

制御 信号 に より 指定 の 長 さ の ワイ ヤ を 巻き 取り 又は 繰り 出す 。 線 長 検出 器 も 公知 の も の 
で あり 繰り 出し て いる ワイ ヤ の 線 長 を 検出 する (例え ば 、 図 1 で ワイ ヤ 伸 縮 機構 か ら 円 盤 
4 まで の ワイ ヤ の 線 長 を 検出 する ) 。 

【0034】 

図 4 は 発明 の 実施 の 形態 に 係る 方 法 の 処理 フロ ー チ ャ ー ト で ある 。 

図 5 は 発明 の 実施 の 形態 に 係る 方 法 を 説明 する た め の 座 標 系 の 説明 図 で ある 。 

図 6 は 発明 の 実施 の 形態 に 係る 方 法 を 説明 する た め の 図 で ある 。 

【0035】 

図 4 乃至 図 6 を 参照 し て 発明 の 実施 の 形態 に 係る 処理 を 説明 する 。 

【0036】 

図 4 の S 1 : 撮像 部 51 で ロボ ッ ト も し く は その 一 部 の 画像 を 取得 する 。 例 えば 、 図 6 ( 
a ) に 示す よう に 、 画 像 P 内 に ロボ ッ ト 7 が 存在 する 。 な お 、 座 標 軸 X'′ , Y や これ に 
付 さ れ た 記号 は 理解 を 助け る た め に 示し た も の で 、 実 際 の 画像 P に は 示さ れ な く て も よい 
も の で ある 。 な お 、X” , Y” ,Z' 座標 系 は 撮像 部 51 を 中 心 と する も の で ある 。 ズ X メ " 
,Y” ,Z' 座標 系 は 図 5 の XYZ 座 標 系 を 移動 させ た も の で ある が 、 各 軸 、 す な わ ち X 
” 軸 と X 軸 と 、Y' 軸 と Y 軸 、Z' 軸 と Z 軸 は 平行 で あっ て 、 座 標 系 は 回 転 し て いな いこ 
と が 好ま し い 。 こ の よう に すれ ば 、 撮 像 部 51 の 回 転 の 補正 を 行わ な く て すむ 。 
[0037]】 

次 に 、 撮 像 部 5 1 と ロボ ッ ト 7 間 の 相対 的 な 水平 位置 関係 ( dx , dy ) を 算出 する ス 
テッ プ S 2 と 撮像 部 5 ら 1 か ら ロ ボッ ト 7 まで の 距離 d z を 算出 する ステ ッ プ に つい て 説明 
を 加え る 。 な お 、 以 下 の 説 明 に お いて S2 か ら S3 の 順番 で 処理 を 行う よう に 記載 され て 
いる が 、 こ れ は 説明 の 便宜 上 の 順序 で あり 、 実 際 に は S2 と S3 に 順序 を つけ る 必要 は な 
い 。 

同 S 2 : ロボ ッ ト も し く は その 一 部 の 画像 の 重心 位置 、 撮 像 部 か ら ロ ボッ ト ま で の 距離 及 
び 撮 像 部 の 倍率 に 基づき 、 撮 像 部 と ロボ ッ ト 間 の 相対 的 な 水平 位置 関係 ( dx , dy ) を 
算出 する 。 
【0038】 

本 シス テム で 3 つの ワイ ヤ 伸 縮 機構 1 乃至 3 が 同一 水平 面 に 設置 され 、 ロ ボッ ト 7 が 円 
盤 4 か らら 垂直 に 吊り 下げ られ て いる と し て 、 図 5 に 示す よう に 水平 方 向 を XY 軸 、 垂 直方 
向 を Z 軸 で 表す こと に する 。 図 5 (a ) は 本 シス テム の 上 面 図 、 同 図 ( b ) は 正面 図 で あ 
る 。 同 図 ( b ) で は ワイ ヤ 伸 縮 機 構 3 の 表示 を 省略 し て いる 。 

【0039】 

ここ で 、 各 ワイ ヤ 121 , 221, 321 の ワイ ヤ の 交点 部 4 へ の 接続 位置 が 形成 する 
三角 形 ( X11, Y11, Z11) (X21, Y21, Z21) (X31,Y31, 2Z3 
1 ) を 、 各 ワイ ヤ の 始点 座標 (X1,.Y1,.Z1)、(X2.Y2.Z2)、(X3、Y 
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3 , Z3 ) の X, Y 平面 へ の 写像 (X1 , Y1 ) 、(X2,Y2) 、(X3, Y3 ) が 形 
成す る 三角 形 の 相似 形 に する と 、 交 点 部 4 の 撮像 部 5 1 を 常に 一 定 方 向 に 向 か せ る こと が 
で きる 。 すなわち 、 三 角形 (X11, Y11, Z11) (X21,Y21,Z21) (Xx 
31,Y31,Z31) の ワイ ヤ の 交点 部 4 に 設置 する 撮像 部 5 1 の 撮像 方 向 が 常に 一 定 
方 向 を 向く よう に な る 。 こ れ に より 、 常 に 撮像 部 5 1 の 撮像 画像 の 座標 軸 方 向 を 3 つの ワ 
イヤ 伸縮 機構 1 乃至 3 の 座標 軸 と の 方 向 を 常に 一 定 に する こと が で きる 。 但 し 完全 な 相似 
形 に し な く て も 、 誤 差 に 応じ て お お むね 同一 方 向 を 向 か す こと は で きる 。 ま た ワイ ヤ の 交 
点 部 4 の 重量 を ワイ ヤ の 重量 より 十分 に 大 きく し 、 ワ イヤ の 交点 部 4 の 三角 形 を 各 ワ イヤ 
の 始点 座標 (X1, Y1, ダル) 、(X2,Y2,Z2) 、(X3、Y3,Z3) の X, 
Y 平面 へ の 写像 (X1, Y1 ) 、(X2,Y2) 、(X3, Y3 ) が 形成 する 三角 形 に 比 し 
て 十分 に 小さ くす る と 、 ワ イヤ の 交点 部 4 の 高 さ を 含ん だ 空間 座標 が 変化 し て も ワイ ヤ の 
交点 部 4 は ほぼ 水平 に 吊り 下げ られ 、 撮像 部 51 は 常に 下 を 向き 撮像 部 51 の Z 軸 方 向 も 
一 定 に 保つ こと が で きる 。 

【0040】 

ロボ ッ ト も し く は その 一 部 の 画像 を 撮像 し 、 そ の 画像 の 重心 の 位置 と 撮像 部 か ら ロ ボッ 
ト ま で の 距離 (予め 距離 は 設定 され て いる 。 ロ ボッ ト 吊り 上 げ 用 ワイ ヤ 6 1 、6 2 の 長 さ 
より も 短い ) と 撮像 部 51 の 倍率 に 基づき 、X' , Y ' ,Z' 座標 系 に お ける 撮像 部 51 
と ロボ ッ ト の 相対 的 な 水平 位置 関係 ( dx , dy ) を 算出 する ( 図 6(a ) ) 。 ロ ボッ ト 
まで の 距離 と 撮像 部 5 1 の 倍率 が 一 定 で あれ ば 、 画 像 P 上 の 画素 ご と に 水平 位置 関係 ( d 
x , dy ) を 予め 決め て お く こ と が で きる 。 あ る い は 、 画 像 P 上 の 画素 の 位置 を 、 ロ ボッ 
ト ま で の 距離 と 撮像 部 5 1 の 倍率 に 基づき 水平 位置 関係 (dx , dy ) に 変換 する こと が 
で きる 。 ロ ボッ ト ま で の 基準 距離 と 撮像 部 51 の 倍率 の 情報 は 予め 画像 処理 部 53 や CP 
U り 1 00 に 与え られ て いる 。 こ の シー ケン ス で は 、Z 方 向 の 正確 な 距離 が 得 ら れ て お ら ず 
、 撮 像 部 51 すなわち カメ ラ と ロボ ッ ト 7 の 間 の 予め 想定 し た 距離 を 元 に 計算 し て いる 。 
その た め 、dx と dy は 厳密 に は 不正 確 な も の で ある が 近似 値 と し て は 十分 に 利用 で き 、 
その 方 向 に 移動 する よう に 制御 すれ ば 、 そ の 目的 地 に 収束 する よう に な る 。 

【[0041]】 

同 S 3 : 画像 の 大 き さ と 撮像 部 の 倍率 に 基づき 撮像 部 か ら ロ ボッ ト ま で の 基準 距離 か ら の 
偏差 dz を 算出 する 。( 2 台 の 撮像 部 で 被写体 の 角度 か ら 偏 差 を 求め て も 良い ) ロボ ッ ト 
吊り 上 げ 用 ワイ ヤ 6 1 、62 が ぴん と 張っ て いる と き は 、 そ の 長 さ と (dx, dy ) から 
dz を 求め る こと が で きる ( 図 6(b) ) 。S4 と 同様 に 、 画 像 の 大 き さ と 撮像 部 の 倍率 
と か ら 逆 算 し て 撮像 部 か ら ロ ボッ ト ま で の 基準 距離 か ら の 偏差 z を 算出 する こと も 可能 
で ある 。 な お 偏差 dz を 用 いな く て も 、 以 下 の S 4 乃至 S 7 の 処理 は 可能 で ある 。 
[0042]】 

同 S 4 : 各 ワ イヤ の 線 長 Wle, W2e, W3e と 各 ワ イヤ の 始点 座標 ( X1 , Y1 , Z 
1) 、(X2,Y2,Z2) 、(X3、Y3,Z3) に 基づき 、 撮 像 部 の 座標 (Xe, Y 
e, Ze) を 算出 する 。 

[0043]】 

各 ワ イヤ 1 21 , 221, 321 の 線 長 を それ ぞ れ Wle, W2e, W3e 、 各 ワイ ヤ 
の 伸張 部 1 2, 22, 32 に お ける それ ぞ れ の ワイ ヤ の 始点 座標 (X1, Y1,Z1) 、 
(X2,Y2,.Z2) 、(X3、Y3,Z3 ) に より ワイ ヤ の 交点 部 4 に 取り 付け た 撮像 
部 51 の 座標 (Xe , Ye,Ze) を 算出 で きる 。 な お 、 モ デル の 理解 を 容易 に する た め 
、 各 ワイ ヤ 1 21 , 221 , 32 1 の 張力 が 無限 大 で 、 ワ イヤ の 交点 部 4 や ワイ ヤ 6 1 , 
6 2 の 重量 を 無視 すれ ば 、 ワ イヤ の 交点 部 4 は ワイ ヤ 伸 縮 機構 1 乃至 3 か ら 半 径 W1e, 
W2e , W3e 、 の 円 の 交点 と し て 算出 で きる (Ze = ニ 0 と 仮定 し た 場合 ) 。 現 実 の 立体 
空間 に 有 っ て も 、 同 様 に ワイ ヤ の 始点 座標 (X1,Y1,.Z1) 、(X2,.Y2,.Z2) 

(X3、Y3,Z3) か ら 半 径 W1e, W2e, W3e、 の 球体 の 交点 と し て 交点 部 4 
に 取り 付け た 撮像 部 51 の 座標 (Xe, Ye,Ze) を 算出 で きる 。 

[0044]】 
同 S 5 : 算出 され た 座標 Xe, Ye に S2 で 算出 し た (dx, dy) を 加算 し て 、 ワ イヤ 


30 


(10 JP 2006-224202 A 20068.31 


の 交点 部 4 が ロボ ッ ト の 真 上 に 移動 する た め の 目 的 位置 座標 (Xd, Yd , Zd) を 求め 
る 


この と き 、Zd に 一 定 の 数 値 を 代入 する と (Z dg が 一 定 の 数 値 に な る よう に 制御 する と 
) 撮像 部 5 1 が 天井 ある い は 床 か ら 常 に 一 定 高 さ に な る よう に 追従 する 。 

また 、Ze に Z 軸 方 向 の 偏差 9 z を 加算 し て Zd に 代入 する と 、 ロ ボッ ト と 一 定 嘘 離 に 
な る よう に 追従 する 。 さ ら に 、 一 定 値 に 9 z を 加算 し て Zd に 代入 する よう な 制御 等 様々 
な 制御 が 可能 で ある 。 

【0045】 

目的 位置 座標 (Xd , Yd , Zd ) は 、 図 6 の dx 、dy を 図 5 の XYZ 座 標 系 で 表現 
し た も の で ある 。 な お 、 ロ ボッ ト 7 の 姿勢 が 変化 し な いた め ワ イヤ の 交点 部 4 の 高 さ が 変 
わら な いと き 、 乙 d = ニ Ze で ある 。 

【0046】 

同 S 6 : (Xd, Yd,Zd) と 各 ワ イヤ の 始点 座標 (X1, Y1,.Z1) 、(X2,.Y 
2,Z2) 、(X3、Y3,.Z3 ) に 基づき 、 目 的 位置 座標 (Xd,Yd,Zd) で の 各 
ワイ ヤ の 線 長 W1c, W2c, W3c (目的 地 の 線 長 ) を 算出 する 。2 つの 座標 問 の 距離 
は 簡単 な 数 式 で 算出 する こと が で きる 。 

で で オア 】 

同 S 7 : 各 ワ イヤ が それ ぞ れ W1c , W2c, W3c (目的 地 の 線 長 ) に な る よう に 、C 
PU100 で サー ボ モ ー タ を 制御 する 。 

【0048】 

上 記 S 1 乃至 S 7 の 処理 に より 、 ロ ボッ ト 7 の 移動 に 合わ せ て ワイ ヤ の 交点 部 4 を 追従 
させ る こと が で きる 。 ロ ボッ ト 7 が 一 定 範囲 内 を 移動 する 限り 、 ロ ボッ ト 7 が 倒れ そう に 
な っ た と き に ロボ ッ ト 吊り 上 げ 用 ワイ ヤ 6 1 , 62 で 支え 、 ロ ボッ ト 7 の 転倒 を 防止 する 
こと が で きる 。 

【0049】 

上 記 S 1 乃至 S 7 の 処理 に お いて 、Z d に 常に 一 定 の 値 に する と 、 垂 直方 向 の 基準 か ら 
一 定 高 さ で の 追従 が 可能 で ある 。 

【0050】 

一 方 で 、d z と Ze を 利用 し て ロボ ッ ト 7 の 高低 が 変動 し て も 撮像 部 51 の 距離 を 一 定 
に する よう な 追従 制御 も 可能 で ある 。 例え ば 、d z が マイ ナス で あれ ば (移動 体 が 立ち 上 
が っ て 交点 部 4 に 近づい た ら ) 、 そ の 分 Ze を 増加 させ る (交点 部 4 を 上 昇 さ せる ) 。d 
z が プラ ス で あれ ば 、 逆 に Ze を 減少 させ る 。( 但し プラ スマ イナ ス は Z 軸 の 定義 に より 
、 反転 する ) 

【0051】 

また 、 階 段 昇 降 や 御 辞 儀 、 屈 伸 等 の 動作 に 応じ て 、 外 部 か ら Zd の 値 を 制御 し て も よい 
【0052】 

また 、( Xe, Ye, Ze) あ るい は (Xd, Yd, Zd)、(dx, dy) や ゃ dz に 
より ロボ ッ ト 7 が ある 範囲 を 超え る 場合 は ロボ ッ ト に 停止 命令 や 減速 命令 を 出す こと も 可 
能 で ある 。 例え ば 、 図 1 の ステ ー ジ S の 領域 を XYZ 座標 系 で 予め 定義 し て お き 、(Xe 
、Ye) 又は (Xd, Yd) が 当該 領域 を 外れ た と き に ロボ ッ ト に 停止 命令 や 減速 命令 を 
出す 。 ま た は 、(dx, dy ) が 予め 定め た 大 き さ よ り も 大 きく な っ た ら ( ロ ボッ ト 7 の 
移動 速度 が 大 きく な りす ぎ た よ うな 場合 に ) ロボ ッ ト に 停止 命令 や 減速 命令 を 出す 。 あ る 
い は 、dz が 予め 定め た 値 よ り も 小さ く な っ た ら ( ロ ボッ ト が 円 盤 4 に 近づき すぎ た よう 
な 場合 に ) ロボ ッ ト に 停止 命令 や 減速 命令 を 出す 。 

【0053】 

また 、 ロ ボッ ト 7 の 転倒 の 判断 は 画像 認識 、 ロ ボッ ト 7 か ら の 信号 、 図 示し な い 外 部 の 
撮像 部 、 ロ ボッ ト 吊り 上 げ 用 ワイ ヤ 6 1 、6 2 の 張力 を 検知 する セン サ 等 、 各 種 の 方 法 で 
判断 可能 で あり 、 転 倒 時 に 本 シス テム を 停止 させ る 、 あ る い は 上 昇 さ せ て ロボ ッ ト 7 を 串 
り 上 げ る こと も 可能 で ある 。 画像 部 51 で 取得 し た 画像 に 基づき ロボ ッ ト 7 の 転倒 を 判断 
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する に は 、 例 えば 、 ロ ボッ ト 7 の 画像 の 大 き さ が 予め 定め られ た 閣 値 より も 大 きく な っ た 
こと で 判断 する 。 ロ ボッ ト 7 が 転倒 する と 横向 き に な り 、 そ の 結果 、 ロ ボッ ト 7 の 画像 の 
面積 が 著しく 増加 する 。 ま た LED 等 の 発光 素子 を ロボ ッ ト 7 の 頭頂 に 複数 設け 、 ロ ボッ ト 
7 を 撮像 し 2 値 化 処理 し た と き に 複数 の 発光 素子 に より 囲ま れる 画像 が 一 定 面積 以下 に な 
っ た 場合 に 転倒 し た 判断 する よう に し て も よい 。 

【0054】 

本 発明 は 、 天 井 の 3 点 を 基準 点 と し て 、3 本 の ワイ ヤ の 巻き 取り 装置 で 、 ワ イヤ の 交点 
を XYZ の 3 次元 で 同時 に 空間 移動 制御 させ る シス テム で ある た め 、 天 井 に 大 掛か りな 駆 
動 レ ー ル 等 を 不用 と し 、 従 来 設置 不可 能 で あっ た 場所 に も 設置 可能 に な っ た 。 
[0055]】] 

し か も 細い 3 本 の ワイ ヤ の 交点 部 を 円 盤 状 に する と あたかも ロボ ッ ト の 頭上 で UFO が 飛 
ん で いる よう で 、 近 未来 的 な ヒュ ユー マ ノ イ ドロ ボッ ト に 釣り 合っ た 斬新 で 画 期 的 な 転倒 防 
止 装置 を 提供 で きる 。 

【0056】 

また 本 発明 に より 、 従 来 天井 に 大 掛か りな 駆動 レー ル 等 が 取り 付け 不可 能 で あっ た 病院 
や リハ ビリ セン ター に お いて も 比較 的 容易 で 省 ス ペー ス に 設置 可能 で あり 、 サ ー ボ モー タ 
を 使用 し た 場合 叶 り 上 げ ト ルク を 容易 に 一 定 に する こと が 可能 で 、 ロ ボッ ト 吊り 上 げ 用 ワ 
イヤ 6 1 、62 の た る み を な くし 、 人 を 一 定 の トル ク で 若干 体重 を 浮か す よ うに 制御 可能 
で ある 。 その 場合 体重 が 足腰 に 掛か る 負担 を 軽減 し 、 部 屋 の 中 を 自由 に 歩行 訓練 で きる シ 
ステ ム も 提供 で きる 。 


【0057】 

また 上 記 人 の 体重 の 軽減 に 着目 し 、 月 面 や 、 宇 宙 遊 泳 の 疑似 体験 装置 と し て の 応用 も 可 
能 で ある 。 

【0058】 


また 本 発明 は 上 述 の よう に あたかも UFO が 飛ん で いる よう で あり 、 外 部 か ら の 制御 で 自 
由 に 操縦 可能 で あり 、 本 装置 事態 を UFO に 仕立 て た 遊戯 装置 と し て 活用 し て も 老若 男女 を 
問わ ず 十 分 楽し め る も の で ある 。 

【0059】 

また 本 発明 は 上 述 の 天井 クレ ー ン に 比 し て 非常 に 静か で ある 。 

また 本 発明 は 上 述 の 天井 クレ ー ン で は 同一 空間 内 で 複数 台 の クレ ー ン を 用 いた 場合 立体 
的 に 交差 不能 で ある が 本 クレ ー ン は 交差 可能 で ある 。 

本 発明 は 、 以 上 の 実施 の 形態 に 限定 され る こと な く 、 特許 請求 の 範囲 に 記載 され た 発明 
の 範囲 内 で 、 種 々 の 変更 が 可能 で あり 、 例 えば 天井 の 4 点 を 基準 点 と し て 、4 本 の ワイ ヤ 
の 巻き 取り 装置 で 構成 し て も 良い 。 ま た 巻き 取り ドラ ム に それ ぞ れ 2 本 以上 の ワイ ヤ を 絹 
っ て も 良い 。 そ れ ら も 本 発明 の 範囲 内 に 包含 され る も の で ある こと は 言う まで も な い 。 

【 図面 の 簡単 な 説明 】 

[0060]】] 

【 図 1 】 発明 の 実施 の 形態 に 係る シス テム の 概略 を 示す 全体 図 で ある 。 

【 図 2 】 発明 の 実施 の 形態 に 係る 円 盤 ( ワイ ヤ の 交点 部 ) を 示す 斜 視 図 で ある 。 
【 図 3 】 発明 の 実施 の 形態 に 係る シス テム の ブロ ッ ク 図 で ある 。 

【 図 4 】 発明 の 実施 の 形態 に 係る 方 法 の 処理 フロ ー チ ャ ー ト で ある 。 

【 図 5 】 発明 の 実施 の 形態 に 係る 方 法 を 説明 する た め の 座 標 系 の 説明 図 で ある 。 
【 図 6 】 発明 の 実施 の 形態 に 係る 方 法 を 説明 する た め の 図 で ある 。 

【 符号 の 説明 】 

【0061]】 

1 2 3 ワイ ヤ 伸 縮 機構 

1、21、31 サー ボ モ ー タ 

2、22、32 ワイ ヤ 伸 張 部 

3, 23, 33 線 長 検出 器 

21、221、321 ワイ ヤ 


つつ つ kk 
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【 図 3 】 【 図 4 】 
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フロ ント ペー ジ の 続き 


F ター ム ( 参 考 ) 3C007 AS36 CSO8 HS27 HTO4 HTO9 KTO1 KTO6 KT17 MS11 MS21 
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